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(57) Abstract: 

PROBLEM TO BE SOLVED: To eliminate a model error to precisely calibrate a position of an 
arm finger in a real time. 

SOLUTION: A representative point angle correction amount table 12 comprising positions of 
respective points within an arm operation range dispersed with optional fixed lengths, and the 
optimum angle correction values corresponding to the respective positions is prepared to 
extract, based on the table 12, plural angle correction amount data in the vicinity of a target 
position and an attitude by a neighboring angle correction amount extracting means 1 1 , and 
the angle correction amount for the target position and the attitude is calculated by an 
interpolation operation using the extracted angle amount correction data. The calculated 
correction amount is added to a target joint angle to calibrate the arm figer position. 




LEGAL STATUS 

[Date of request for examination] 

[Date of sending the examiner's decision of rejection] 

[Kind of final disposal of application other than the examiner's decision 
of rejection or application converted registration] 

[Date of final disposal for application] 

[Patent number] 

[Date of registration] 

[Number of appeal against examiner's decision of rejection] 

[Date of requesting appeal against examiner's decision of rejection] 

[Date of extinction of right] 



Copyright (C); 1998,2003 Japan Patent Office 



.oaimiHM' (j p) <i2) & ffl tfe ft $g ( A ) aommomn 

#192002-219674 
(P2002- 219674A) 

<43)&WB ¥£14^8/3 6 0(2002.8.6) 



(51)Inta T 




FI 


f^?>r<^) 


B 2 5 J 9/10 




B 2 5 J 


9/10 A 3 P 0 6 9 








5fS»8 Sfcfc»eDlc3 OL <£: 6 M) 




ft«2001-13833(p2001 -13633) 


(7DBBU 


000006822 








tt^dttftfMlft 


(22)0WB 


¥£13^1 £220 (2001. 1.22) 










C72)SW# 


«a 








ft WKttWnjrAft BEC|Wf«S 2 # m- 














<72)£9i# 
























(74) ^SA 


100082164 



















(54) HH?©«#3 T-A«tettBO**U^>-^a>j(jBi3W* 



(57) imm 

-^«rfflV^*W*»|cJ:i?H«tta» ft9»AAft3ElO 




4?f?R2002-219674 



1 

[«W©SMHfcSftW] 
[0 0 0 1 J 

[0 0 0 2] 

t?*> ij , r co* -v y y u— v 3 ^ssg 5 o Ti*r— a g 

Wg»S 5 1 5 f-? 5 1 CA^t 

5, T-Xs^ 5 U— ? 5 U*, A^LfcT-Aggltfi: 
©g&S 5 1 %ftU<or — A*5M~-* 7" — A-=ef* 50 



2 

tS52t LTSO^SSS 3 tlA h^^feis^AtVtiMI 
S2^mftirZ> 0 S77 Wt-*fifc>^$M*fcijSS5 2», & 

*tlc(&UfcWtt*»i:»*bfcfc*As 5 3 (ASMS 

a) ^r+y ^i^-v-s vigss o(c*5 

W**P#«§5 a 14, HfllftfrfrS 5 2ig* h;U*fcfc> 
^«SS3 (ftgffiiES) iSrApgU IIE^M 
S 5 4 SrW^-tS 0 9- 1 7 4 4 6 6). 

[0 0 0 3] 

I«M*«**UJ: 5 'i-rs»H] A*5fettfll 

y r U-i/ s vi4BSgT-fc 5 £ v » 5 R3SAt> £>o fc. 
[0 0 0 4] *ZX\ HB#RaT-C9df+ y 7U 

— >b ^Srftli!f«T-^a-r57'-A^{ftgtf>* + y y 

[0 0 0 6] 

**JS^tr-»4, fflBwflteft^ttfMfcacfLfcr-AS&ttJ 

»«A*«r3E**r»iU-r«. =. 5 LT»aLfc«jEft& 
B^B8fi!5ftA^*PiT7-A^jtettJg«5*+y^U— > 

[0 0 0 6] 

[0 0 0 7] Sill, *»W»*a»ttlC«ST-A* 

Jtefit.fao^'ir W7i — -> s v^go*sffiS;?r^-f0T-& 
•9, rco^-v-y ^l^-Va vaSfi6»tB«[ffiffft9»^ 
3, i3j;tWwS|t«7i»b«fi5llSH-C^Se 

[ 0 0 0 8 ] m 2 14, fltt«Eft£Jft?J9: 3 «9«Jtt«:9 
i-H-C**. Bl2(c*JV^-C, 1 1 l4a««SffijESi4W 

¥«1 3i{C«iggLTV>5. 

[0 0 0 9] !§J3iia4l4, ftaAfta*E*5 , -#^ 



( 3 ) 



#§82002-219674 



(AdXi, AdXk, AdXm) cDBagp^gltiEfif 1, 

[0 0 10] £*T, Hi. 0 2, BI'3&VIB4«ra(caio 

lOOli] H«ffiBJSF»4feriE*«J:t)4j*4nfcr- 
f, Yref, Zref) «rB«B81S!A*±Jtt^S2 ^AA«3E 

Pi,k,m 



-AB«ttHS»S 1*»&H«SMW!KS 2 (ang 1 , an 
«2, . . . ang 6) ZtiUlrfZ. AS^jEft^fiK^Ss 

fl£ffi3Efttttf]9j& 1 lKA^L (BI2) , 

Ad*i< Xref < Arfx (j + 1) 
Arfx Ar < fre/ < At/ x (it + 1) 
&dxm<Zref<Adx(m + l) 

[«C2] 



S13 



Pi t k,m=» 



Pi+\,k+\,m+l 



A6l(1,k,m) 
A03(i,k,m) 



A0n(Xref ,Yref ,Zref )= Nlx&0n(i +1,* + 1,bj +i) 

+ Af2x Afin(i,* + l,m +1) 
+ //3x Aen(l,k,m +1) 
+ ^4xAft)(/ + l,* p « +1) 

+ tf7x A0n(i,k,m) 

+ N&x A$n(i+ l,k,m) (fi=i,2,..£) 



AT) = + IK* ♦ IX* + U 



a = Xref- Ad xi 
b = Yntf-6dxk 
c = Zref -Atixm 



N4, = - tlx*- 1X^*1) 



= - IX* + lXc-D 
- -ix*-i)(*-») 



#8 ■ + IX* -IX* - I) 



( 4 ) 



#062002-2 19674 



[0 0 1 2] ^®^EaS3 lei *) AS?MjES*vfcI« 1 

^•frg9jm#S£S4 (sngRefl, angRef2, . . angReffi) 2 

[0 0 13J 5 

^^SMiESi:*^^5^^^g*S]Ea7 ? -^7 L -7 , '10 1 2 

AK«nEA«r4tmSS|C|£ J; (3 -b k J6 % fcfc^a 2 2 

5fc«>, ^*©«-BSfl5roRiJ«SSk, 5 0 

9 9 v^sa*^<o*y/w<?>— * s i 

lc«Hi-*»i»39«**ni", ietfSScor-A^ftftKOT 5 2 

T-^P«ffiB»»«r|*«A< S2 

immnmwtm} s 3 

[01] *»W©3IJfc»fflilC<R»r-A«iiMfi£«©*+20 S4 

y y > s >jfiao«j««r*i-. s 5 

10 2 J ftattEJtei***<9flMtfc91*. s 1 2 
[El 3 ] ft*jWtAltjEa* , -4'T— 7A><OVt&&& S 1 3 

' S 5 1 

[El 4] tt$t£.fi&ffim&7 ! ~#T-y'A><numzffi S5 2 

T. S S 3 

[051 S£5fe<©** y — : >a ^SSa»«^Sr^-r. S54 



■IBB1] 




( s ) 



45BU2002-219674 



[132] 



11 



JZ1 



/ — u 



Pi*. «r»l 




IB4] 



Pi.tt.mm 



( 6 ) 



^gfl2002-2I9674 



Sil 




<.72)%ffi% && ft ¥{t-M^m 3F059 FB17FC14 

tBH»*^«mA«WK«M»«5 2 « 1 # 



